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I. INTRODUCTION 


Bua tyoicadl taeceteabemissile trajectory, standoff (or 
mid-course) guidance is required when the missile is launched 
at such long ranges from the target that either the missile 
seeker cannot detect the target or, if it can, the information 
is of such poor quality that is unusable. The mid-course 
guidance law usually consists of some pre-programed strategy 
such as to maintain the launch heading, constant altitude 
and speed. Mid-course guidance is primarily an inertial 
instrumentation problem. Typical sensors onboard missiles 
consist of three rate gyros (pitch, yaw and roll), accelero- 
meters, sometimes magnetic compass and some kind of altimeter. 
Additional state information can be provided by the seeker. 

A radar seeker could provide range and range rate. 

Here is considered the problem of using steady-state 
Kalman Filters as part of a navigation system, where the two 
estimators together (longitudinal and lateral estimators), 
constitute a strapdown system that does not use accelero- 
meters or gimbaled gyros. Strapdown Inertial Navigation 
Systems (INS) using Steady-State Kalman Filters (SKF) as 
estimators have been considered as cheaper and easier to 
implement than the gimbaled INS. The sensors used in this 
analysis are: pitch and roll rate gyros, altimeter and mag- 


netic compass. Since constant gain estimators have been 


ish 





suggested as easier and cheaper to implement, the analysis is 
confined to the SKF. 

This work has been motivated by the idea given in Ref. 
[4], where the author discusses in detail the configuration 
of such a navigation system as described before, but the 
problem is presented as a particular application in the INS 
of the DC-8 airplane. For convenience the model used here 
Beeemerally 1s the same as Ref. [4] in lieu of a missile. 
This was done in order to eliminate classification problems. 

This thesis investigates only one aspect of the INS 
problem. That aspect is the sensitivity of the Kalman Filter 
to inaccuracies in the filter parameters or variation between 
the filter model and the plant model. These differences can 
be due to either inaccuracies as indicated or to a normal 
variation in the flight parameters due to different flight 
regimes. One result of this is the sensitivity of rms 
estimate errors to inaccuracies or differences in the sta- 
bility derivatives. 

The work was begun by reproducing the results given in 
Ref. [4] with the correct implementation of the dynamics in 
the filter parameters (i.e., Xu, Yv, etc.) over a given 


range and noting the effect on the accuracy of the filter. 
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If. STOCHASTIC MODELS AND ESTIMATION 


A. KALMAN FILTER 

The Kalman Filter is widely documented and no attempt at 
a development of general theory has been made in this work. 
A brief description has been included in order to establish 
the particular formulation used. For a more complete de- 
velopment one is referred to Ref [1]. 

1. Linear Dynamic System 

The formulation used employs state-space notation 

which offers the advantage of mathematical and notational 
convenience, Consider the linear time invariant system 
(system and measurement models) given by equation (1), where 


xX represents the states of the system; z is the 


bd 
lt 


Fx + [Iw (l-a) 


Z2= tx + v (1-b) 


Measurement vector; F is the system matrix; Tf is the driving 
noise coefficient matrix; H describes the relationship between 
the states and the measurement; w and v are independent, zero- 
mean white gaussian noise process with covariance matrices Q 


and R respectively, that in mathematical terms are given by: 


E(w(t)w! (t)) 
E(v(t)v* (t)) 


il 
© 


OCC) OCT eer (C)) 
RCEyicGe-«)), EG@y(t)) 


(2-a) 
(2-b) 


il 
© 


1s, 





2. Continuous Time Kalman Filter 
A continuous time Kalman Filter is described bv 
equation (3), where - is the state estimate; K is a matrix of 
constant filter gains. The implementation of the System 
Model and the Kalman Filter is shown in block diagram in 


Figure l. 


ee nee) (3) 


MATHEMATICAL MODEL 
ee yt KALMAN FILTER 


SYSTEM MEASUREMENT | 
| 
| | 
| ara 
| | 


: e se f tO540- ae 


es 


=e ame aE eps i 


— come cee lc eee eee eee eee 


Figure l 
system Model and Kalman Filter 
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The estimate error is defined by equation (4) as, 


me 
it 


K- xX (4) 
and the differential equation for x is given by 
x = (F-KH)x - [Iw + Kv (>) 


The differential equations for the state of a linear system 


driven by white noise can be expressed as 


| (6) 


The covariance of the estimate-error, designated P, is given 
by equation (7). It provides a statistical measure of the 
uncertainty in x. 


P = Efxx a 


The diagonal elements of the covariance matrix are the mean 
square errors in the knowledge of the state variables. Also, 
the trace of P is the mean square length of the vector x. 

The off diagonal terms of P are indicators of cross-correlation 
between the elements of x. The covariance matrix P is obtained 


by solving the linear Lyapunov equation given by 


eS 





a 


Pp = (F-KH)P + P(F-KH)! + ror? + KRK (8) 


The eigenvalues of the filter are the roots of equation (9). 
[SI - F + KH| = 0 (9) 


B. STATE AUGMENTATION AND SHAPING FILTERS 

When the system random disturbances are correlated in 
time, i.e., colored noise, it is necessary to use their 
power spectral density data in order to develop a mathematical 
model that produces an output which duplicates the noise 
characteristics [Ref. 2]. Correlated random noises are taken 
to be state variables of a fictitious linear time invariant 
system (generally called a shaping filter) which is itself 
excited by white gaussian noise. Such a model is given by 
equation (10), where the subscript f£, denotes filter and n, 
1s a nonwhite, i.e., time-correlated, gaussian noise. The 


filter output is used to drive the system as show in Fig. 2. 
n = HpX- (10-b) 


The dimension of the state vector (1) is increased by 
including the disturbances as well as a description of the 
system dynamics behavior in appropriate rows of an enlarged 


F matrix, this is called state vector augmentation. 


16 








Figure 2 


Shaping filter generating driving noise. 
Conformation of the Augmented System. 


The augmented state equation is given by 


x F ine x Q 
cag ig de Sag Gal) 
Xf O } F x le 


The associated measurement equation given by equation (12) 


z =(H |! 0] a + (12) 


C. SENSITIVITY TO PARAMETER VARIATION 
Observing the structure of the Kalman Filter illustrated 


in Figure 1; the filter contains an exact model of the system 
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dynamics, The filter gain matrix is calculated using the 
parameters of the exact model of the dynamics. 
1. Incorrect Implementation of Dynamics 

The analysis of how the error covariance behaves when 
the gain matrix is computed using wrong values of F matrix, 
i.e., varying parameters due to different flight conditions, 
is quite well explained in Reference [1]. Figure 3 shows the 
block diagram for the system model and the Kalman Filter, 
where the quantities K* and F* represent the gain matrix and 


the system dynamics implemented in the filter. 





Figure 3 


Block diagram of the System Model and Kalman 
Filter with incorrect implementation of dynamics. 
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The equation for the estimate is given by 
a 


= F*¥x + K*(z-Hx) 


x 
xX = 


The error in the estimate given by (14) 
(FX - K*H)x + AFx - [Iw + K*¥v (14) 


x = 


where 


A 
AF = F* - F 


The differential equations for the states of a linear system 


driven by white gaussian noise given previously by equation 


(6) becomes now 
% FX - K*H ! aF] | Key - Tw 
= —~--—-—-+-4 |-4j + }----- Gis) 
x 0 | FI [x rw 
aun 
Letting x' be the augmented state vector, x' = 2 ; 
where the covariance matrix of x' is given by: 
(16) 


le 
E(x'x'Ty =|-+— 
V | U 


where 
19 





ence awe Bese ue EGel) 


The quantity of interest is P, the covariance of x. 


The error sensitivity equations are given by 


P = (FX - K*H)P + P(F* - K*H)? + aFV 
T_T T T (17-a) 
+ viar? + ror? + K*RK* 
V = FV + v(F* - x*H)? + yar? - ror? (17-b) 
ty 2 my > oe ere Give 


With initial conditions 
P(O) = -V(0) = U(0) = E(x(0)x(0)*) 


when the actual system dynamics are faithfully reproduced in 
the filter, i.e., F = F*, AF = 0, the equation (17) reduces 


to the linear Lyapunov equation given by equation (8). 


D. MODAL COORDINATES TRANSFORMATION 

The representation of the system given by equation (1) is 
not unique. Considering an alternative linear transformation 
of the states given in references [3] and [4] , let x = TE, 
where € represents the transformation of the states and T is 


the transformation matrix with the columns formed by the 
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eigenvectors of the system matrix F (for a complex eigenvalue, 
the first column is the real part and the second column is 
the imaginary part of the eigenvector). The similarity 


transformation of equation (1) is given by 


€& =WAE - Bw (18-a) 

Ze oe ey (18-b) 
where 

= rae = T Pf) C =eHT 


A case of particular interest (canonical form) occurs 
when the resulting A matrix is diagonal (the eigenvalues of 
the F matrix form the diagonal). The design of the estimator 
in modal coordinates is analogous to using transfer functions 
fiepectial Eraeewon form. The canonical form is more inforn- 
ative than the transfer frunction method, since observability 
and controllability can be obtained by inspection. 

E. SOLUTION OF THE KALMAN FILTER WITH A PRESCRIBED DEGREE 

OF STABILITY 

The Kalman Filter designed with constant gain (SKF) and 
used as an observer will diverge if there are undisturbed, 
neutrally stable (UNS) modes in the system model. In refer- 
ences [4] and [5] the authors presented the idea of 


\ 
Zak 





destabilization of the system model (1), the amount of de- 
Stabilization can be varied until the resulting suboptimal 
observer has a specified degree of stability. The method 
presented in Ref. [4] refers only to destabilizing the UNS 
modes in the system model, that method is called "modal 
destabilization" (MDS). The gains of the filter are con- 


strained so that 
Re(Si) 2 -c, i = 1,2,....n (19) 


where Re (Si) indicates "real part of (Si),'"' S,,....Sn are 
the eigenvalues of the filter, i.e., the roots of equation 
(9) and o is a specified positive number. 

The original system is destabilized in accordance with 
equation (20), where F' is the resultant destabilized matrix, 
E the destabilization matrix (diagonal) and T is the modal 
transformation matrix (eigenvector matrix). The matrix F' is 
used in order to calculate the modified gains of the filter 


(suboptimal gains), 
F' =F + TET! (20) 


This method avoids the divergence of the steady-state 


Kalman Filter with a slight decrease in estimation accuracy. 
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IIIT. DYNAMIC AND MEASUREMENT SYSTEM MODELS 


A. REFERENCE AXIS SYSTEM 
The Reference Axis System in a missile is centered on the 
c.g. and fixed on the body as follows: 


X axis, called the roll axis, forwards, along 
the axis of symmetry. 


Y axis, called the pitch axis, outwards and to 
the right if viewing the missile from behind. 


Z axis, called the yaw axis, downwards in the 
plane of symmetry to form a right-handed 
orthogonal system with the other two. 
The symbols from Appendix A define the forces and moments 


acting on the missile, the linear and angular velocities, and 


the moments of inertia; those quantities are shown in Figure 





Z,W Relative Wind 


Figure 4 
Reference Axis System 
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B. MISSILE EQUATIONS OF MOTION 

The equations of motion used in the present study in order 
to represent the missile dynamics are quite well defined in 
Reference [7]. A linear dynamical model of the missile based 
on the rigid body approximation is appropriate. 

1. Longitudinal Motion 

The longitudinal motions of a missile are modeled by 

a fifth-order system given by equation (21), where the state 
variables are u, velocity along the X axis; w, velocity along 


the Z axis; q, pitch rate, 4, pitch angle and h, altitude. 


a Xw Xw 0 -2Z 0 u 

W ZW ZW V 0 0 W 

4) = |MutMyZu MwtMwZw MqtMwV O 0] | q] (21) 
4 0 0 1 0 0 

h 0 -1 0 vO h 


2. Lateral Motion 
The lateral motions of a missile are modeled by a 
fifth-order system given by equation (22), where the state 
variables defined are; 8 sideslip angle; r yaw rate; p roll 


rate; » roll angle; wy heading angle. 
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B Yv -1 0 z/V 0 8 
z I 1 i 
i: Ne Ne No OQ QO ag 
= 1 1 1 
p Lg ob. by 0 0 p (22) 
b 0 0 1 0 0 b 
v 0 ri 0 0 0 v 
C. MODEL 


The aerodynamic data used in the present study is given 
in Appendix B [Ref 9]. Essentially the models and noise 
dynamics are those of reference [4]. 

1. Longitudinal Motion Estimation 

The main disturbance inputs are the two wind velo- 
cities Ug and Wy Under the particular flight conditions, 
the turbulance represented by the fluctuating parts of Ug and 
Wy are color noise. They are modeled by first-order shaping 
filters with white gaussian noise inputs as given in equation 


(10). The resultant linear model is given by equation (23) 


[Ref 8]. 


Uy -0.413 oO | ju, 0.413 Oe ice 
“= + 


We 0 -0.853] |we 0 0.853] | u 


(25) 
The numerical data for the longitudinal dimensional 


derivatives was used in equation (21), the resultant model is 
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given by equation (24), that corresponds to the state vector 
augmentation given by equation (11). Units are scaled with 


Gaaw, WU. and a Mmmeumees or LO £t/Ss, gq Im units of 0.01 rad/s. 


é -0.015 0.004 0 -0.0322 0 -0.015 0.004 |/u | Jo 0 

w -0.074 ~-0.806 0.824 0 0 -0.074 -0.806]//w | |0 0 

q -0.749 -10.7 -1.344 0 O 0.749 -10.7 |/q 0 0 

@ |= 0 0 7 0 0 0 0 a +10 Oo 

h 0 -0.1 0 0.0824 0 0 0 ne ee 0 

by 0 0 0 0 Oe onaas 00 u,| [0.413 0 | 

E 0 0 0 0 0 0 -0.853| w lo 0.853) 
(24) 


Peer units of 0.01 rad., and h in units of 100 ft. 
The measurement model given by equation (25) assumes 
a rate gyro in order to measure z_ and a barometric altimeter 


g 
im Order to measure Zi 


u 
WwW 
Z mo. 1. 0 0 0 614% 1 Oley 
q 9 q 
= SR (25) 
Zo 0 0 0 0 i 0 0 h QO l Yn 
ie 
Wg 
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Z; Lateral Motion Estimation 
The main disturbance input is lateral wind Ve: The 
turbulence represented by the fluctuating part of Vp PS color 
noise, it is modeled as a first-order shaping filter with 
white gaussian noise input as given in equation (10). The 


resulting shaping filter is as given by equation (26) and 


taken from Reference [4]. 


ee ee Onesec 0.853 
Bo Po u 


where (26) 


The numerical data for the lateral dimensional derivatives 
was used in equation (22) to obtain the equation (27). This 
corresponds to the state vector augmentation given by 


equation (11). 





-0.0868 -1 0 0.03907 O -0.0868 B 0 
2.14 -0.228 -0.0204 0 0 Le Mies r 0 
-4.41 0.334 -1.181 0 0 -4.41 Pp 0 
= ~_ uu 

0 0 1 0 0 0 > 0 
0 1 0 0 0 0 > 0 

0 0 0 0 QO -0.853 Bg 0.853 

— 


(27) 


Da 





The measurement model given by equation (28), represents the 
situation where the measurement 25 is taking with a roll-rate 


gyro and the measurement Z, using a magnetic compass. 


1 0 ue 
- (28) 


O01 Vv 


<_- Co VU RD 


WD 
aQ 
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IV. ANALYSIS 


A. THE SIMULATION 

A computer program was developed in order to solve the 
sensitivity equations given by equation (17). Basically, the 
program was used to handle a set of 105 linear differential 
equations in the longitudinal case and 78 in the lateral. 

The principle program output is the time history of the P 
matrix and the square root of its diagonal elements (the rms 
estimate errors). 

The Kalman Filter computer program was the primary tool 
used in computing the gains. The program was develcped at 
the Massachusetts Institute of Technology [Ref. 10] and 
adapted for use at the Naval Postgraduate School. A second 
computer program composed at Stanford University, OPTSYS 4 
Computer Program [Ref. 11], which utilizes several options of 
the Kalman Filter, was also implemented in this analysis. In 
particular, the suboptimal filter using the modal destabili- 


zation (MDS) design option was required for the lateral case. 


Bee lth RESULTS 

As the problem is described, the results are presented in 
two parts, the longitudinal and the lateral case. 

Initially both models given by equations (24) and (27) 
were modified in order to include another state in each of 


them, the perturbed position. The resultant observers were 
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tested, but in both cases they were unstable. 

1. Longitudinal Motion Estimation Analysis 

A steady-state Kalman Filter was designed LRef. 4] 

and used as a constant gain state estimator (equation (3)). 

The first step in this analysis was to reproduce the 
results for the case of exact implementation of dynamics in 
the calculation of the Kalman gain matrix. That analysis was 

done using the M.I.T. Kalman Filter Computer Program [Ref. 10]. 


The results are shown below: 


Peele cweecmieiiadtolx kK, 


ORGS 0.060 
0.264 =-0.161 
Say 0.040 
Om00 1 -0.080 
Or0 13 0.136 
=O, 0701 O05) 
OS Onze 


Filter Eigenvalues 
-0.310 a j0.411 


-0.429 
=O, 178 
-0.261 
-0.063 + j0.0743 


mms estimate errors 


u = 2.090 ft/s 6 = 0.317 deg 

w= 5.102 ft/s h = 8.245 ft 

q = 0.416 deg/s ug = 4,776 ft/s: 
Weer. 701 ft/s 





These results are essentially identical to those of Ref. [4]. 

The next objective was to consider the incorrect 
implementation of dynamics in the Kalman Filter, in order to 
study the sensitivity of rms estimate errors to inaccuracies 
in the stability derivatives. The numerical variation of the 
parameters were considered individually in order to establish 
the F* matrix to be used in equation (17) and also for finding 
the filter gain matrix K* to be implemented in the same 
equation. For each variation of the parameter under obser- 
vation it was necessary to run the M.I.T. Computer Program 
LRef. 10] in order to find the matrix of gains K* and then to 
run the sensitivity covariance program in order to study the 
propagation of the estimate errors. 

The results are shown in Tables 1-8 and Figures 5-40. 
In the Tables, the true value of each parameter is marked with 
an asterisk. The description of the results are: 

Xu. The dimensional variation of X force with forward 
speed (u) has a nominal value of -0.015. This quantity was 
changed in a range of +20%. The behavior of the rms estimate 
errors are presented in Table l. From that it can be seen 
that any numerical variation of Xu derivative does not cause 
significant changes in the nominal values of the rms estimate 


errors of the states, w, q, 0, Ug and Woe For the states 
u and h the results are shown in Figures 5-6 respectively, 
with some effect, but not significant for positive variation 


Of wus, 
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Xw. The dimensional variation of X force with down- 
ward speed (w) has a nominal value of 0.004. As before, the 
numerical variation was performed in a range of +20%. The 
behavior of the rms estimate errors were tabulated in Table 
2. Checking the results there is no variation in the nominal 
fetes of cms estimate errors of the states, w, q, 8, Ug and 
Wo for any of the changes made in Xw derivative. The vari- 
ations in the estimate errors for U and h are indicated in 
Figures 7 and 8 respectively. Increasing the value of Xw the 
u error decreases but h increases, while taking smaller values 
of the parameter, the effect is contrary. Those changes in 
the rms errors are considered not important. 

Zu. The dimensional variation of Z force caused by 
a change in forward speed (u) has a nominal value of -0.074. 
The effects of changing its design value was observed in a 
range of 20% and its result condensed in Table 3 as well as 
in Figures 9-14. All the rms errors show some degree of 
sensitivity except q. The most important changes occur in 
an 8, and h errors and the iBone oOnmmeugecan begin to 
be important in terms of accuracy in radial position. 

Zw. The dimensional variation of Z force with down- 
ward speed (w) has a nominal value of -0.806. The results 
for this case are presented in Table 4 and Figures 15-20. 


Again, the variation in the value of Zw was made in a range 


of +20%.. All the rms estimate errors show a large degree of 
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sensitivity and it can be considered that any numerical vari- 
ation of Zw beyond + 2% is critical and unacceptable. 

Mu. The dimensional variation of M moment caused by 
a change in forward speed (a) has a nominal value of -0.000786. 
The value of Mu was changed in a range of 20% and the results 
are given in Table 5 as well as Figures 21-26. Any variation 
in Mu quantity does not cause important changes in the value 
of the rms estimate errors of the states, q, Ug and Wo. For 
For the states u, w, 6, and h, the variation in the errors 
can be considered with some significant effect for large 
deviations of Mu value, i.e., more than +10%. 

Mw, The dimensional variation of M moment with speed 
(w) has a nominal value of -0.0111. Its numerical variation 
was taken in a range of +10%. From Table 6 and Figures 27-32, 
it can be seen that any alteration in the true value of Mw is 
reflected with a strong effect on all the rms estimate errors. 
This derivative can be considered the most critical in the 
longitudinal motion estimation case. 

Mq. The dimensional variation of pitching moment with 
pitch rate (q) has a nominal value of -0.924. The results 
are given in Table 7 and Figures 33 and 34 for a range of 
+20% in the numerical variation of Mq. The sensitivity of the 
rms estimate errors due to changes in this parameter is min- 


tmoum for all the States. 
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Mw. The dimensional variation of pitching moment 
with rate of change of downward speed (w) has a nominal value 
of -0.00051. Table 8 and Figures 35-40 presents the infor- 
mation about the changes of the rms estimate errors in a 
range of +20% in the variation of Mw derivative. All the 
errors show some degree of sensitivity and with more than +27 
in the alteration of the Mw value, the variation in the errors 
begins to be significant. 

2. Lateral Motion Estimation Analysis 

The dynamic system (equation (27)) and measurement 
models (equation (28)) were transformed into modal coordin- 
ates in accordance with equation (18). This was done using 
the OPTSYS 4 Computer Program [Ref. 11]; the results are 


given below: 





=).119 1.490 0 0 0 0 epi -1.702 
“1.490 -0.119 0 0 0 0 ED2 -0.610 
0 0 -1.254 0 0 0 ER -5.106 
- + Lu] 
0 0 0 -0.0041 0 @) aS -0.004 
0 0 0 0 0 0 EH 0 
0 0 @) 0 QO -0.853 Eve 3/56 
ED) 
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§D1 
ED2 


=r =O) eet) 
a : it 0 0.782 0 1 =-0.605} | ER fs Vp (30) 
24 Gee omeeresoee-Unewes 0.995 1 0.162 || &S Or OL Vy 
EH 
Sy 


These results are identical to those given in Ref. 
[4]. In the same reference the author gives a complete 
analysis of controllability and observability using the re- 
sults given in equations (29) and (30). From these can be 
seen that the spiral mode €S has its eigenvalue close to the 
origin and it is almost undisturbed by the process noise; also 
it is unobservable with the measurement Zp. Using a steady- 
state Kalman Filter as an observer fail to estimate the 
heading mode €H and its estimation of the spiral mode &S is 
too slow. The next objective was to take the SKF and to con- 
sider the situation of parameter variations in the dynamic 
implemented in the filter, With the true values of the F 


Matrix implemented in the filter the results are shown below: 


Ei iGeaeeaine Matrix, K 


O20a0 -0.967 
-1.536 0.411 
ZOg -0.004 
0.386 -0./789 
=~ 005 0.906 
cares 0.655 
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Filter Eigenvalues 
= enoo0 + 12259 
-0.624 + j0.492 
=Om00L25 

O20 


rms Estimate Errors 


VB = 3.329 ft/s 
r= 0.244 deg/s 
p = 0.377 deg/s 
6 = 0.222 deg 
w = 0.214 deg 


V8g = 5.506 ft/s 


These results are essentially identical to those 
from Ref. [4]. The filter was found to be stable but with a 
narrow margin of stability. Any attempt to change parameters 
resulted in a failure of the estimator due to divergence with 
the most minimum variation (i.e., +1%) of any of the para- 
meters. This result complements the analysis given previously 
LRef. 4] and it shows definitely that it is impossible to use 
the SKF as an estimator for the lateral motion with the actual 
configuration of the model given by equations (27) and (28). 
The alternative solution was to design a suboptimal 
observer (MDS) with the constrain (19) as given in Ref. [4], 
o = 0.029 and using equation (20) in the MDS option the 


computer program OPTSYS 4 [Ref. 11]. The results are: 
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These results are essentially identical to those 


Geom Ref, [4]. 


The sensitivity of the lateral rms estimate errors 


due to inaccuracies in the stability derivatives was studied 


using the suboptimal filter (MDS) design and following the 


Same procedure explained before for the longitudinal case. 


The results are shown in Tables 9-15 and Figures 41-76. The 


results are described in detail as follows: 
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Yv. The dimensional variation of Y force with side 
velocity (v) has a nominal value of -.0868. This value was 
changed in a range of +20% and the results appear in Table 9 
and Figures 41-44. r, p, b, and V8g show almost no sensi- 
tivity to the variation in Yv parameter, VB changes but it 
can be considered of secondary importance. The most sensi- 
tivity change occurs in b and it begins to be important for a 
variation of +5% in Yv value. 


Ni. The dimensional variation of yawing moment about 


B 


Z axis with sideslip angle (8) has a nominal value of 2.14. 
Table 10 and Figures 45-50 give the results for a variation 
of Na derivative in a range of +10%. All the rms estimate 
errors except " present strong sensitivity, especially V8 
and ¢. With a variation of more than +1% the estimation of 
these errors begin to show large values and the filter takes 
a long time to reach the steady state value (more than 150 s). 
For that reason, any variation in the true value of Na with 
the purpose of implementation in a Kalman Filter as an esti- 
mator must be considered unacceptable. 

Nr. The dimensional variation of yawing moment about 
Z axis with yaw rate (r) has a nominal value of -0.228. In 
a range of +20% the variation of N; value was performed and 
the results tabulated in Table 11 as well as the important 


variations registered in Figures 51-54. The effects on 


sensitivity of all the rms estimate errors are secondary and 
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there is no important alteration in their values due to large 
variations in the Np parameter. 

Np. The dimensional variation of yawing moment about 
Z axis with roll rate (p) has a nominal value of -0.0204. 
This number was changed in a range of +20% and the results 
observed are given in Table 12 and Figures 55-60. fr, p, v, 
and vVBe rms errors do not present any important variation. 
The sensitivity in rms estimate error is observed in V8 and 
6, in particular. For the last one, the change is too large 
for a variation of 5% in the value of the parameter. 

L4. The dimensional variation of rolling moment 
about X axis with sideslip angle (8) has a nominal value of 
-4.41. Its variation was given just in a margin of +10% be- 
cause with larger changes the estimator starts to diverge. 
The results obtained are given in Table 13 and Figures 60-66. 
All the rms estimate errors show some degree of sensitivity 
due to the variation in Lg parameter and with 1% of change 
some of the errors like Vg and$¢ present very large vari- 
ations. For that reason this derivative must be considered 
critical in the implementation of the Kalman Filter as an 
estimator. 

Lr, The dimensional variation of rolling moment 
about X axis with yaw rate (r) has a nominal value of -0.334. 
The results presented in Table 14 and Figures 67-72 are the 
product of the observation for the variation of the parameter 


Ly in a range of +10% and it can be considered as the most 


a0 





important stability derivative for the lateral model, because 
the dynamics implemented in the filter does not allow any 
variation of its true value, otherwise, the estimation of the 
errors becomes to be too large and probably the filter can 
diverge. In other words, the sensitivity of the estimator 
to any variation in Ly value is extremely critical. 

Lp. The dimensional variation of rolling moment 
about X axis with roll rate has a nominal value of -1.204. 
The behavior of the rms estimate errors were observed taking 
a variation of +10% of the Lp parameter and they are given 
in Table 15 and Figures 73-76. V8 and r are the variables 
that present some degree of sensitivity in the increment of 
their rms estimate errors, respectively, and they begin to be 
important with a variation of more than +5% of the Lp true 
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Figures 5 & 6. Sensitivity of u and h rms estimate errors vs 
variation in Xu stability derivative 
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Figures 9 & 10. Sensitivity of u and w rms estimate errors vs 
variation in Zu stability derivative. 
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Figures 11 & 12. Sensitivity of h and 8 rms estimate errors vs 
variation in Zu stability derivative. 
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Figures 13 & 14. Sensitivity of Wa and U, rms estimate errors vs 
variation of Zu stability derivative. 
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Figures 15 & 16. Sensitivity of u and w rms estimate errors vs 
variation in Zw stability derivative. 


nie ES] Mel Ewen OmeeeS Zh 


oO Figure 16 


oO 


Greasy 


W 


Ww 


tae -0.93 -0.86 -0.79 Ome -0.65 
ZW 





U9 


ene Meeme ERROR VS ZW 


Figure 17 


ue 


ee. 


0.43 


1.00 -0.93 -0,86 =o 7c Sore -0.65 


ZW 


Figures 17 & 18. Sensitivity of q and § rms estimate errors vs 
Variation in Zw stability derivative. 
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Meeves 19 & 20. Sensitivity of h and ug rms estimate errors vs 
variation in Zw stability derivative. 
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Figures 21 & 22. Sensitivity of u and w mms estimate errors vs 
variation in Mu stability derivate. 
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Figures 23 & 24. Sensitivity of 9 and h rms estimate errors vs 
variation in Mu stability derivative. 
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Figures 25 & 26. Sensitivity of w, and Ug rms estimate errors vs 
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Figures 27 & 28. Sensitivity of u and w rms estimate errors vs 
variation in Mw stability derivative. 
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Figures 29 & 30. Sensitivity of q and § rms estimate errors vs 
variation in Mw stability derivative. 
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Figures 31 & 32. Sensitivity of h and w, rms estimate errors vs 
variation in Mw stability derivative. 
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Figures 33 & 34. Sensitivity of u and h rms estimate errors vs 
variation in Mq stability derivative. 
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Figures 35 & 36. Sensitivity of u and w rms estimate errors vs 
variation in My stability derivatives. 
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Figures 3/7 & 38. Sensitivity of q and § rms estimate errors vs 
variation in Mw stability derivative. 
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Figures 39 & 40. Sensitivity of h and wo rms estimate errors vs 
variation of Mw stability derivative. 
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Figures 41 & 42. Sensitivity of Vg and p rms estimate errors vs 
variation in Yv stability derivative. 
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Figures 43 & 44. Sensitivity of 8 and Veg rms estiamte errors vs 
variation in Yv stability derivative. 
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Figures 45 & 46. Sensitivity of V2 and r rms estimate errors vs 


variation in Ng stability derivative. 
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Figures 47 & 48. Sensitivity of p and 8 rms estimate errors vs 
variation of Np stability derivative. 
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Figures 49 & 50. Sensitivity of w and V8, rms estimate errors vs 
variation in Ne Seaeanel es derivative. 
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Figures 51 & 52. Sensitivity of V2 and r rms estimate errors vs 
variation in Ny Stability derivative. 
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Figures 53 & 54. Sensitivity of § and Ve rms estimate errors vs 
variation in No stability derivative. 
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Figures 55 & 56. Sensitivity of Vg and r rms estimate errors vs 
Variation in ue Stability derivative. 
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Figures 57 & 58. Sensitivity of D and § rms estimate errors vs 
variation of ue stability derivative. 
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Figures 59 & 60. Sensitivity of and Vg rms estimate errors vs 
variation in BE stabilify derivative. 
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Figures 61 & 62. Sensitivity of Vg and r rms estimate errors vs 
variation La Stability derivative. 
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Figures 63 & 64. Sensitivity of p and 6 rms estimate errors vs 
variation in Le Stability derivative. 
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Figures 65 & 66. Sensitivity of w and VBe rms estimate errors vs 
variation in Le Stability derivative, 
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Figures 67 & 68. Sensitivity of Vg and r rms estimate errors vs 
variation of L) stability derivative. 
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Figures 69 & 70. Sensitivity of p and 6 rms estimate errors vs 
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Figures 71 & 72. Sensitivity of W and Ve rms estimate errors vs 
variation of L! stabiltiy derivative. 
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Figures 73 & 74, Sensitivity of VB and r rms estimate errors vs 
variation in oo Stability derivative. 
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Figures 75 & 76. Sensitivity of 6 and V8, rms estimate errors vs 
variation in ue stability derivative, . 
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V. CONCLUSIONS AND RECOMMENDATIONS 


A. CONCLUSIONS 

Using steady-state Kalman Filters as observers in an 
inertial navigation system, the sensitivity of rms estimate 
errors to inaccuracies in the stability derivatives was 
studied. The conclusions reached at the end of this research 
are presented in two parts as they were analyzed. 

1. Longitudinal Motion Estimator 

a. Numerical variations in the dimensional deriv- 
atives; Xu, Xw and Mq do not show any important effect in the 
rms estimate errors. The value of these parameters as imple- 
mented in the filter can have large variations with respect 
to their nominal values (perhaps a tolerance of +20%). 

b. Changes in the stability derivatives; Zu, Mu 
and Mw are reflected with variation in almost all the rms 
estimate errors. In particular, large variations in u rms 
estimate error can begin to be important in terms of accuracy 
in the radial position. These parameters can be implemented 
in the dynamics of the filter with some degree of tolerance 
with respect to their true value (for the case under analysis 
no more than +5%). 

c. The most important effects are found with the 
variations of the stability derivatives; Zw and Mw. Zw gives 


the strongest alterations in all the rms estimate errors and 


me 





small changes (+2% the tolerance in the case under study) in 
this parameter are unacceptable in the filter. For Mw the 
situation is quite similar and the value of this derivative 
is very important. In general, Zw and Mw must be faithfully 
reproduced in the filter. 
2. Lateral Motion Estimator 

It is not possible to use the SKF as an observer 
under the particular configuration of the models given for 
lateral motion. The filter is stable but with a narrow margin 
of stability. The most minimum numerical variation (i.e., 
+1%) in the value of any stability derivative results in a 
failure of the filter due to divergence. This result com- 
plements the discussion given in Ref. [4]. Using a sub- 
optimal filter (with modified gains), the effect of the 
numerical variation in each of the stability derivatives 
are: 

a. Numerical variations in the dimensional deriva- 
mives. Yv" Ne and Ly do not cause important effects in any of 
the rms estimate errors. The reproduction of these para- 
meters in the filter are not required to be too accurate 
(considering in this case a tolerance of +10%). 

b. Np is a parameter that only accepts small vari- 
ations in its value (in the problem discussed, 2% of toler- 
ance) because it has strong effects in the estimation of rs 


ms eStimaite error, 
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c. The stability derivative Na is one of the most 


important in terms of faithful reproduction in the dynamics 
of the filter. In general, it can be said that any numerical 
variation in its true value is not allowed. 

Qe aaa La 
situation, because a minimum change in its value is reflected 


and Lr present the most dramatic 


with very large changes in the estimation of rms errors and 
it can result in divergence of the Kalman Filter. The lateral 
motion estimator design requires that these stability deriva- 
tives must be reproduced in the filter with the maximum of 
accuracy, otherwise, the result can be failure of the filter. 
Of the two estimators used in the implementation of 
the INS, the lateral filter is more sensitive to variation in 
its parameter value. It should be remembered that the con- 
clusions reached in this analysis apply specifically to the 
model being analyzed. Other models involving different 
missiles may indicate different sensitivities. 
Nevertheless, it is felt that the conclusions presented 


in this thesis are of general validity. 


B. SUGGESTIONS FOR FURTHER ANALYSIS 

The most obvious extension of the work would be to test 
the estimators using the real data for a missile. 

Further study could be to consider the same problem de- 
Signing the estimators with a model that includes the addition 


of the estimation in position in order to analyze the problem 


i 





in terms of miss distance in radial position for a missile 
that at the end of the mid-course guidance phase must hit a 


"basket" (terminal guidance phase). 
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VI. SUMMARY 


The great advantage of the analysis in the sensitivity 
of rms estimate errors to inaccuracies in the stability 
derivatives is that it points out clearly which derivatives 
are worthy of detailed accurate determination and which are 
MO . 

The following table summarizes the level of importance of 
each of the stability derivatives in the implementation of 
the steady-state Kalman Filters to be used as estimators in 


an INS. 
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LONGITUDINAL MOTION 


LATERAL MOTION 


NI 
ot 
ie 


ESTIMATION 


ESTIMATION 


DERIVATIVE 


ll 


Xu 
XW 
Zu 
LW 
Mu 


Mq 


fant eb ra A 
W- HR- W- U- R- We 


NI SI 
X 
X 
i 
i 
X 
X 
X 
X 


Not Important 


Secondary (Relative) Importance 


Primary Importance 
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APPENDIX A 
LIST OF SYMBOLS 


Demin clon 


Modal transformation of F matrix 
Modal transofrmation of [ matrix 
Modal transformation of H matrix 
Dutch roll mode 

Destabilization matrix 

System dynamics matrix 

Subscript for filter 
Destabilized matrix 

Subscript for wind speed 
Measurement matrix 

Heading Mode 

Altitude 

Inertial Navigation System 
Kalman Filter gain matrix 
Rolling moment (about X axis) 
Pitching moment (about Y axis) 
Modal destabilization 

Yawing moment (about Z axis) 
Non-white gaussian noise 


Covariance propagation of the estimate 
error matrix 


Perturbed roll rate 
Covariance matrix of w 
Perturbed pitch rate 
Covariance matrix of v 
Perturbed yaw rate 

Spiral mode 

Steady-state Kalman Filter 


Transformation matrix 
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Regular Symbols 
UNS 


MoM MM 2 FE 4 < eG 


N N + MM 


Greek Symbols 


ive eel Clara GO. -O- -CD 


Derini elon 


Undisturbed neutrally stable 
Perturbed forward speed (along X axis) 
Forward velocity 

Perturbed side velocity 
Driving white gaussian noise 
Perturbed downward velocity 
Reference axis 

State vector of the system 
State estimate vector 
Estimate error vector 
Reference axis 

Measurement vector 


Reference axis 


Definition 
Heading Angle 
Perturbed pitch attitude angle 
Perturbed bank (roll) angle 
Sideslip angle 
Driving noise matrix 
Eigenvalue constrain 
Standard deviation 
Transformed state vector 
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APPENDIX B 


AERODYNAMIC DATA AND PROBABILISTIC INFORMATION 


v = 820 ft/s 


1. Longitudinal Model 


a. 


Dimensional Derivatives 


Xu = -0.015 I1/s 

Xw = 0.004 #«£i1/s 

Zu = -0.074 I/s 

Zw = -0.0806 I1/s 

Mu = -0.0786 I1/s-ft 
Mw = -0.0111 1/s-ft 
Mq = -0.924 1/s-rad. 
Mw = -0.00051 1/ft 


Disturbance Noise Standard Deviation 
oe = el o/s CEO es) 


(7 ft/s rms gust with a 930-ft correlation 
distance). 


Observation Noise Standard Deviation 


O215 s (0.01 rad/s) 
0505 ‘cere LOCn tei 


oq 
Ch 


2, elaeecals Models 


a. 


Dimensional Derivatives 


Yy = -0.0868 1/s 
Ng = 2.14 1/s* 
=) 0 3226 eal /s 
Ny = -0.0204 l/s 


So 





Lg = -4.41 1/s* 
Ly 0.034 l/s 


Lo Siewkole) L/s 


Drustmapance Noise Standard Deviation 


o = 1.63x10°* 1/s (7 ft/s rms gust with a 
930 ft correlation distance) 


Observation Noise Standard Deviation 


1 SRT! e 


ee: 


oy 1.5x107> l/s 
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COMPUTER OUTPUT 


Table l. rms estimate errors for longitudinal motion estimator 
with variation in Xu derivative. 


Xu ft/s ft/s deg/s deg ft ft/s ft/s 


Table 2. rms estimate errors for longitudinal motion estimator 
with variation in Xw derivative. 


. u W q 3 h Ug ce 
fes.| ft/s deg/s ee fos ft/s 
0.0048 23076 >. 102 0.416 On 317 8.319 Lia? 7'6 5. /0m 
0.0044 2.000 2 lOZ 0.416 O95iy/ SuZow 4.776 5. 


0.0042 2.086 |; 5.102 | 0.416 O.3P7 | 8.257 407/76 | SavOl 
0.004 2.090 | 5.102 | 0.406 0.317 | 8, 8.245 ) 4.776 | 776 5.701 TAGE 


0. (0.0038 Bileo |S. 102" |. 4 | ofsty | S8228" | 4u776 | 5.701 
0.0036 Page) | Sea02 | onze | O=3me | Qe2iSe | 4.776 | 5.70. 701 


0.0032 Zee | 5. POL | OS4E6 @.S06" |} Soi70 4.776} 5.701 


87 
































fable 3. rms estimate errors for longitudinal motion estimator 
with variation in Zu derivative. 


eee 
ram [oan [som [rae [om [ram [om [a 


Table 4. rms estimate errors for longitudinal motion estimator 
with variation in Zw derivative. 


: = - - Fi : = 
deg | ft ft¥s | ft7s 
-0.9612 30.08 6.7 Z 0.486 0.440 17.97 4.778 7.138 
-0.8866 11.80 5.810 0.428 0.415 33.50 4.785 5.947 


-0.8463 Sage 1 5/259 | 0.421 Ons OOm™ aan | 4,779 | 5.737 
-0. _= 2aus0 | 55 5.102 0.416 On3iy | 82 | 3.245 4. 4.776 5.701 TOU 


=O. /-0.7657 2,008 | 5.032 | 0.4i2 On2ie lemeos |; 4.772 | 5.710 
=Om 720 Joloee | 2.035 | 0.407 0.200 | 21.026 | 4.769 | 5. 5.746 


=O 005 3.260 | 5.065 { 0.406 O-165") 25m000 | 4.767 | 5.79% 
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Table 5. rms estimate errors for longitudinal motion estimator 
with variation in My derivative. 


Ww 

ey 

ar ARARAPESaAE: 
-0.000943 Za | >. 001 0.416 O7505)nonzsu 4.775 | 5.689 


~0.000865 7 leiomeeo. OO9 QO. | 0.46 0.310; 6.640 42719. 5.095 























~0.000825 5.094 0.416 O23 ie) oo 4.776 5.698 


Table 6. rms estimate errors for longitudinal motion estimator 
with variation in Mw derivative. 


ie Me | eis | corte | cope| ee | tie | ee 
} =0.01165 } =0.01165 18.43, 43 | 8. ) 8.350 02302 OF 0.455 29me7Or) 4.778 | 5.695 
-0.0113 Demos | 3.La2 0.433 Omer siti eet) 4.778; 5.694 


-0.00999 opis?) 1LSw95 0.475 68.98 SoG vO. LOZ 
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Table 7. rms estimate errors for longitudinal motion estimator 
WHEN Varzation in Mg derivative. 


u W 
ft/s tts B -, 
-1.109 2.091 5.102 O e416 05316 $2230 4.//6 Seaeonl 
-1.016 2.091 5.102 O «4186 0.3586 8.234 Lie, 4.776 ) 5.701 701 
-0.9/70 22091 Sr 2 Ce 416 Oois7 Sa ob A716 Der 
-0.924% 2.090 peo Cece Oeaiy 8.245 4./76 DOL 


-~0.880 PaesJO mia siwe | O46 0.316 | 8.244 2 0 Wee. (OL 
= 2 O50 eo. 102 | 0.416 ao COM ccs 0 oO Gee). / OL 


mo. 7392 Paco) o.102 | 0.416 enor eomre 312 feo | >. 1 OL. 


Table 8. rms estimate errors for longitudinal motion estimator 
with variation in M5 derivative. 


pa fade Lai f deel STE TT 
-0.00061 2eOLO 5 055 O.417 OFZ LOsGo> Sr | 5.688 
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Table @aple 9. rms estimate errors for lateral motion estimator with 


variation in Y derivate. 
csi ie i 
Bes deg/s deg 


-.10416 Boo eG 0.246 0.380 0.236 0.216 ie 


-.08246 Se Oomm 0.245 | 0.378 O.2237 106215 Dey OZ 
)-.07812 | oe 3.76 Gr245 0.378 C220 Or 9.694 


-.06944 Seore | 0.245 | 02377 Og214 | On2L5 22077 


gate 10 10. rms estimate errors for lateral motion estimator 
with variation in N4 derivative. 


ate el a eb 


2.033 4.956 Oa224 "|| 09359 ORoO55) | OnZeEs 6.543 
ieagia> 8.781 On2Ol | O29 eon | s0n220 8.240 


oil 

























Table 11 ll. rms estimate errors for lateral motion estimator 
with variation in N,. derivative. 


Pe [ae [el al foe | ok [te 
ft/s deg/s deg/s ft/s 
-0.2736 3.790 0.248 0.380 02225 Oz 17 5.704 


=0. 21:66 3.805 Oreo) 0.379 O22 2.0m 0 «26 5.714 
=@. 205 2 Ol) 0.246 | 0.379 0220) wUz Dee 


-0.1824 3.834 Oreas | 0.379 Oe 25 1 es 26 Dar), 


















Table dae 12. rms estimate errors for lateral motion estimator 
with variation in Np derivative. 


eras 
ft/s deg/s | deg/s deg £e/s 
-0. j-0.02008 jo.a21 JiZaae 0.247 247 0. [0.380 0. 0.318 QO. jo.21e 5.826 826 


o2 











Table 13. rms estimate errors for lateral motion estimator 
With variation in Le 


TE [edalada |b 1h [os 
~4.8510 0.120 O556 0.885 0.089 2.266 


~4.3659 4.268 0.249 | 0.382 OF S19) Om2 29 Bae eS, 
-4.3218 4.640 Q2250 120.390 0.402 {0.220 OE2o> 
38 


aoe bO95 5.246 OE255 0.393 0.492 | 0.224 


Table 14 14. rms estimate errors for lateral motion estimator 
with variation in ioe 


-0. 0.3674 )12.030° 030 ) 0.233 233 0.352 BO2 0. } 0.205 QO. }9.300 8.149 


9s 
































fable 15 15. rms estimate errors for lateral motion estimator 


Wichevaria Eton ine Ls. 

4... SRE 
et /s deg/s | deg/s ft/s 

0.228 0.219 S725 


18 p-1.1573 ae 3.802 | Oe2tom | 0.3/9 O22265) | Oa2lo pei 12 


~1.122 SpOOremmoec4o | 0.379 Omeeoe | Ol2i7 me to 
ak. 063 0.4255 Oe22/ | Oee20 Diet Le 
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DO 31 [=1,NS 


L=L+l 
31 VAR(LI=UCT) 


J, 
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peg 32. i 

DO 32 J 

L=L+1l 
VAR(LI=V( 1[,J) 
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SUBROUTINE FUN(NV,Ts«VAReDRV) 


FUNCTIONS (INPUT) 


IS USED FOR EVALUATING 
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